Cálculo del cuaternion de la orientación del porta-herramienta en el programa de simulación RoKiSim

Referencia: https://www.youtube.com/watch?v=0FbDyWXemLw

ECUACIONES DE CUATERNIONES

Rotación

Complemento

Multiplicación

NOTA:

Aunque MathCAD permite a través de las preferencias determinar el valor índice de inicio para el uso de los contadores de posición en vectores y matrices, es mucho más claro declarar una variable DUMMY (que no se utiliza, pero ocupa un lugar) para el elemento CERO del vector de juntas del robot en MathcAD y de esta manera hacer compatible los índices con la simulación RoKiSim, en donde el contador de juntas inicia en UNO.

POSICIÓN #0

Los valores de RoKiSim son:

(0.70711, 0.00000, 0.70711, 0.00000)

POSICIÓN #1

Los valores de RoKiSim son:

(0.51947, -0.14965, 0.81800, 0.19658)

POSICIÓN #2

Los valores de RoKiSim son:

(0.50007, -0.56168, -0.65777, 0.04232)

POSICIÓN #3

Los valores de RoKiSim son:

(0.02889, 0.70838, 0.44152, 0.54993)

POSICIÓN #4

Los valores de RoKiSim son:

(0.35747, 0.35429, 0.85953, 0.08893)

Resultados